%% trilat v4 data test

PosSat=[ 11444831.05221008   19872840.57973936   13728071.85325433
   21785914.68839423  -14994024.60020150   -2170721.88255118
    3212056.70511895   16183670.97379929   20991792.25531062
   24942174.32843526   -6388801.36023855    5402212.53356499
    1195920.25707193   11063821.95266633   22939698.71433310
   18145958.69520752    4263888.93265055   17455352.81043831
   24947589.14906330   -4934531.99415899    1854461.69202178
   -6657718.01422543  -11530656.37469918   21713972.45052304
   18376303.08997944   17132894.04142752    4134933.11377418
   16726095.51423849    5204214.53759907   18615419.45406315
    4843647.53926071  -10481999.87226815   22743324.33548736
   13454800.75585186  -10548095.66695257   24172059.17200766
   23142340.23483522    6199666.64357544   17401292.51168756
   15117533.29061808   12135888.20837992   22373461.26689805
   -4304574.90666355   17778898.32638553   23268376.94286145];
   
Dobs=[22802832.6356383
   24249925.3849583
   22795477.0645223
   21767854.6910630
   21379454.3096778
   19280239.4503991
   21568614.1723032
   23282631.3174427
   22099764.9893620
   19324799.6039738
   20904806.4927388
   24021128.7930734
   23541272.4521513
   23904583.8767031
   26899521.4848443];
 
sat_const = [1
   1
   1
   1
   3
   3
   3
   3
   3
   3
   3
   2
   2
   2
   2];
 
    
sat_PRN = [14
   20
   22
   32
    6
    7
    8
   14
   21
   22
   23
   11
   12
   19
   20];
   
ElevSat = [0.558552823634507
   0.244826360103808
   0.555978123836005
   0.693232870921394
   0.597053508422228
   1.354954792413861
   0.550666933371064
   0.227979813720520
   0.436239218923382
   1.337363224378820
   0.710230392004965
   1.011858626769485
   1.223379190238839
   1.053633855014414
   0.335255764209228];


X0=[4.20157720900000e+06
   1.89859856000000e+05
   4.77906456700000e+06
   0.00000000000000e+00
   0.00000000000000e+00
   0.00000000000000e+00];


